import time
from ArmIK.ArmMoveIK import *
import Board

if __name__ == "__main__":
    AK = ArmIK()
   # setBusServoPulse(6, 500, 1500)
  #  time.sleep(1)
   # setBusServoPulse(3,180, 1000)
   # time.sleep(1)
   # setBusServoPulse(6,880, 1000)
   # time.sleep(1)
    Board.unloadBusServo(6)
    Board.unloadBusServo(5)
    Board.unloadBusServo(4)
    Board.unloadBusServo(3)
    Board.unloadBusServo(2)
    Board.unloadBusServo(1)
  #  setBusServoPulse(6,580, 1000)
    print('可以开始转动舵机')
    time.sleep(10)
    print('关节1位置是: {}\n2位置是: {}\n3位置是: {}\n4位置是: {}\n位置是: {}\n位置是: {}\n'.format(Board.getBusServoPulse(1),Board.getBusServoPulse(2),Board.getBusServoPulse(3),Board.getBusServoPulse(4),Board.getBusServoPulse(5),Board.getBusServoPulse(6)))


